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This  document  presents  the  use  of  Kalman  filter  methods  for  making  optimum 
use  of  incoming  range  and  doppler  information  in  determining  a target 
track.  Specifically,  it  (1)  illustrates  the  fundamental  application  of 
linear  Kalman  filter  mathematics;  (2)  expands  the  matrix  equations  to  show 
the  form  and  characteristics  of  the  filter;  (3)  shows  two  methods  of  making 
the  filter  adaptive  to  target  maneuvers  through  use  of  statistical  properties 
of  the  measurement  residuals;  and  (4)  presents  a means  of  using  the  . , 
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AN  ADAPTIVE  KALMAN  FILTER  TRACKER  FOR 
MULTI -MODE  RANGE/DOPPLER  SONAR 

INTRODUCTION 

In  most  modern  sonar  systems,  each  active  ping  produces  a combination  of 
information  on  both  the  range  and  the  range  rate  of  the  tarqet.  This  informa- 
tion is  then  used  to  form  the  basis  of  a target  track.  This  document  presents 
the  use  of  Kalman  filter  methods  to  make  optimum  use  of  the  incominq  range  and 
doppler  information  in  forming  the  track.  The  first  part  of  the  discussion 
shows  the  fairly  routine  application  of  linear  Kalman  filter  mathematics,  and 
expands  the  matrix  equations  to  show  the  actual  form  of  the  filter  and  some  of 
its  characteristics.  Two  methods  are  then  discussed  for  making  the  filter 
adaptive  to  tarqet  maneuvers  through  use  of  statistical  properties  of  the 
measurement  residuals.  Finally,  a means  is  described  for  using  the  uncertainty 
matrix  of  the  tracker  to  select  the  optimum  waveform  for  the  next  ping,  when 
the  desire  is  to  minimize  the  range  error  at  some  future  time. 


DISCUSSION 

The  steps  required  in  defining  a Kalman  filter  problem  involve  first 
describing  the  state  vector  X to  be  estimated,  modelinq  the  dynamic  evolution 
and  the  random  processes  influencing  this  state  vector,  and  then  describing 
the  relationship  between  this  state  vector  and  the  measurements  beinq  made 
on  it,  along  with  the  uncertainty  in  these  measurements.  For  the  problem 
at  hand,  we  will  estimate  the  range  and  the  range  rate  of  the  tarqet.  Thus, 
the  state  vector  X becomes 
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X = 


x 


2 


range  in  meters 

range  rate  in  meters/second 


In  describing  the  evolution  of  this  state  vector,  we  wish  to  show  that 
the  range  is  the  integral  of  the  range  rate  and  that  the  range  rate  is 
influenced  randomly  by  target  maneuvers.  This  can  be  done  by  writing 


Xp  (w-  Xp  ) /t 

where  the  differential  equation  for  x^  causes  it  to  behave  as  a low-pass 
process  with  relaxation  time  t with  w as  a white  noise  excitation.  Thus, 
the  range  rate  will  evolve  from  its  current  value  toward  some  new  unknown 
value  described  only  by  its  variance,  in  a time  on  the  order  of  t seconds. 
Putting  this  into  the  matrix  notation  of  continuous  Kalman  filters  gives 

x = f x + r>  w 

where 


o 

1 

o 

F = 

and  G = 

1 

1 

Cj 

_1/t_ 

Now  given  this  information  on  the  dynamics  of  the  process,  it  can  be 
shown  that  the  uncertainty  matrix  P on  the  estimate  of  the  state  evolves 
according  to  the  differential  equation 

P = F P + PF1  + G (]  r,1 
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where  Q is  the  power  density  of  the  noise  process  w.  Expanding  this  matrix 
equation  for  the  three  components  of  P gives 


P11  2 P12 


P12  " P22  ‘ P12/t 


P22  = ~2  P22^t  + 


The  above  differential  equations  are  simple  enough  to  be  integrated  to 

show  the  evolution  in  both  the  best  state  estimate  and  in  the  uncertainty 

matrix  from  a time  t to  a new  time  t. 

o 

These  results  are 


x i ( t ) = x -j  ( t o ) + a t x2(tQ) 


x2(t)  = (l-a)x2(t0) 

P 1 1 ( t ) = Pi^to^  + 2aT  P12^to^  + a T P22^V 

+ [2(t-to)/T  -2a  -a2]  t2  V2 

= P12^o^  + a^1_a^T  P22^o^  + W?T  V? 

P2?(t)  = (l-«)2P??(to)  + a(?-a)  V2 


where 


a = 1 - exp(-(t-to)/T) 


3 


TD  5234 


2 

and  V = Q/2t  has  been  introduced  as  the  value  toward  which  the  mean  squared 
range  rate  uncertainty  evolves. 

It  is  interesting  to  look  at  these  equations  both  for  prediction  times 
short  compared  to  t,  where  a - (t-t  )/t,  and  for  long  prediction  times  where 
a approaches  unity.  In  the  short  time  limit,  these  equations  may  be  reduced 
by  droppinq  higher  order  terms  in  t-t  to  those  which  are  obtained  if  a 
discrete  model  of  the  process  were  used.  In  the  long  time  limit  the  range 
rate  uncertainty  P00  evolves  from  P00(t  ) toward  the  a priori  uncertainty  in 

ry  L C.  l.l.  0 ry 

velocity  Vc.  The  covariance  term  evolves  toward  the  constant  tV  , which 
indicates  that  the  range  error  and  range  rate  error  in  the  estimates  will 
eventually  be  positively  correlated.  The  range  uncertainty  has  perhaps 
the  most  interesting  characteristic.  This  uncertainty  contains  a term 
contributed  by  each  of  the  initial  components  of  the  uncertainty  matrix,  and 
each  of  these  terms  approaches  a constant.  In  addition,  there  is  a term 
which  eventually  increases  linearly  with  time  and  is  proportional  to  the 
variance  of  the  target  velocity  and  to  its  relaxation  time. 

It  is  now  necessary  to  describe  the  process  by  which  new  measurement 
data  are  inserted  into  the  filter.  This  is  a discrete  process  and  is 
described  by  a measurement  matrix  H giving  the  relationship  between  the 
measured  parameters  and  state  vector  of  the  filter.  Since  the  measured 
information  from  each  ping  is  also  range  and  range  rate,  it  would  seem  that 
the  relation  between  the  state  vector  and  the  measurement  is  trivial. 
However,  this  is  not  so  because  of  the  acoustic  propanation  time  delay 
involved.  The  measurement  is  taken  at  the  time  the  signal  reflects  from  the 
target,  but  is  not  available  at  the  tracker  input  until  the  siqnal  returns 
to  the  sonar.  If  an  attempt  is  made  to  maintain  the  track  directly  in 
current  time,  a term  of  the  form  x-j  - x^/c  appears  in  the 
measurement  equations  and  causes  the  tracker  to  be  nonlinear.  This 
complication  can  be  eliminated  by  developing  the  tracker  in  the  form  shown 
in  figure  1.  The  first  part  is  the  actual  Kalman  filter,  and  it  is  updated 
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once  per  ping  cycle  with  a new  state  vector  X,  a new  uncertainty  matrix  P, 
and  a time  representing  the  time  of  reflection  of  the  last  echo.  This  time 
is  computed  by  subtracting  the  one-way  travel  time  at  the  estimated  range 
from  the  actual  time  of  receipt.  While  this  technique  does  not  completely 
eliminate  the  nonlinearity,  because  of  the  uncertainty  in  the  range 
estimate,  it  does  reduce  it  to  second  order. 


Figure  1.  Configuration  of  the  Kalman  Filter 


In  most  cases  a range  estimate  is  desired  more  frequently  than  once  per 
ping  cycle.  Thus,  a second  element  is  shown  in  figure  1,  which  uses  the 
most  recent  information  in  the  Kalman  filter  to  provide  a current  (or 
future)  estimate  for  X,  and  if  desired  for  the  estimated  uncertainty  P. 

With  this  technique  the  measured  parameters  become  identical  to  the  state 
parameters,  so  the  measurement  matrix  H is  simply  a unit  matrix.  The  error 
matrix  for  the  measurement  is  a 2 by  2 matrix  R. 

With  this  definition  of  the  problem,  the  process  for  updating  the 
Kalman  filter  estimate  involves  first  computing  the  new  update  time  t by 
subtracting  the  one-way  travel  time  from  the  time  of  echo  reception  (or 
adding  it  to  the  time  of  transmission).  The  state  estimates  and  the  P 
matrix  are  then  updated  to  that  time.  The  process  of  inserting  the  new  data 
involves  first  computing  a Kalman  gain  matrix  of  the  form 

K = P Ht  [h  P Ht  + r]  _1 
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which  is  multiplied  by  the  vector  of  measurement  residuals  Y - H X to  map 
them  into  corrections  to  the  state  vector  in  the  form 

x = x + k[y-hxJ 

The  K coefficients  thus  represent  the  relative  weights  attached  to  the  new 
measurement  as  compared  to  the  previous  estimate.  Finally,  the  P matrix 
is  adjusted  according  to  the  equation 

P = P - K H P 

to  represent  the  reduction  in  uncertainty  due  to  the  introduction  of  the  new 

data. 


Since  the  H matrix  has  been  found  to  be  a unit  matrix,  we  can  expand 
these  equations  in  terms  of  the  P matrix  at  the  time  of  the  echo  and  the  R 
matrix  associated  with  the  ping  waveform  to  give 


11  = 

= [Pll 

(P22  + 

r22)- 

P12 

(pJ2 

r2?) 

”(P12  + 

R12^ 

2] 

12  = 

- (P12 

Rirpn 

ri2) 

/[ 

<P1! 

21 

(p12 

R22_P22 

ri2) 

' [ 

?U 

22  = 

[P22 

<P11  + 

RH)- 

'P12 

(P12 

R??) 

‘^12  + 

‘ R12' 

i2] 

R12^]  1 [^Pll  + R11^P22  + 

R11^P22  + R22^P12  + R12^  ] 
R11^P22  + R22^P12  + R12^  ] 
R12)]  7 [(P11  + R11)(P2?  + 


for  the  Kalman  gain  equations. 
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for  the  state  vector  corrections, 
'll'  1 11  " K12P12 


Pn  = O-Kn)  P, 


and 


j 

t 


12 


(i-Kn) 


12 


- K UP 22 


22 


(i-k22) 


22 


K21P12 


for  the  adjustments  to  the  P matrix.  Note  that  the  differences  between  the 
observed  and  predicted  values  of  both  range  and  range  rate  are  used  in 
correcting  both  state  estimates,  as  desired.  The  Kalman  gains  tend  to  be 
ratios  of  variances.  In  a simple  example,  if  both  P^  and  were  zero,  K^ 

becomes  P^/(P^  + R^)  or  the  variance  of  the  range  estimate  divided  by  the 
variance  of  the  measurement  residual,  as  might  have  been  expected.  Note 
that  for  any  cross-coupling  to  occur  between  the  range  and  range  rate 
estimates,  either  P^  or  must  be  non-zero.  However,  as  we  have  seen 
earlier,  the  P,^  covariance  term  will  always  evolve  toward  a positive 
non-zero  value. 

As  shown  before,  the  terms  of  the  P matrix  tend  to  increase  between 
measurements  due  to  the  random  process  assumed  in  the  model,  while  it  is 
seen  here  that  the  measurement  process  tends  to  decrease  the  P matrix. 
Normally,  if  measurements  are  taken  on  a reqular  basis  these  two  effects 
balance  to  give  stable  values  to  the  P matrix.  These  effects  point  up  the 
need  for  the  random  perturbations  in  the  target  model.  If  they  were  not 
included,  the  P matrix  would  tend  to  zero,  causing  all  the  Kalman  gain  terms 
to  qo  to  zero.  The  filter  would  then  no  longer  respond  to  new  measurements, 
being  satisfied  that  it  knew  all  there  was  to  know  about  the  target.  This 
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is  the  malfunction  known  as  divergence  in  Kalman  filter  literature. 

A simulated  example  of  the  performance  of  this  Kalman  filter  is  based 
on  the  target  track  shown  in  figure  2a.  The  target  proceeds  inbound  at  10 
meters/second  (about  20  knots)  from  a range  of  10  kilometers  to  a range  of 
5 kilometers.  It  then  makes  a 90-degree  turn  at  3 degrees  per  second  and 
again  proceeds  in  a straight  line.  This  track,  translated  into  a trajectory 
in  range/range  rate  space,  is  shown  in  figure  2b.  Sonar  data  is  assumed  to 
come  from  a sonar  operating  at  5 kilcHertz  with  a 100  millisecond  Continuous 
Wave  (CW)  pulse.  A pulse  is  transmitted  immediately  after  each  echo  is 

received,  giving  an  interpulse  interval  of  6.5  to  13  seconds,  depending  on 

range.  While  the  measurement  uncertainty  in  an  echo  strictly  depends  on 
signal-to-noise  ratio,  this  dependency  is  ignored  here  and  the  standard 
deviations  in  the  echo  measurement  are  assumed  to  be  100  milliseconds  in 
time  and  10  Hertz  in  doppler.  This  is  equivalent  to  75  meters  in  range  and 
1.5  meters/second  in  range  rate,  and  these  two  errors  are  uncorrelated. 

The  most  interesting  part  of  the  track  is  the  shaded  area  of  figure  2b, 
extending  from  just  before  the  turn  until  the  target  range  and  range  rate 
again  begin  to  chanqe  significantly.  This  region  is  shown  enlarged  in 
figure  3a,  with  the  actual  target  track  shown  by  the  solid  curve  and  the 

measured  data  shown  by  the  open  circles  connected  by  the  dotted  lines. 

Since  the  measurement  error  is  large  compared  to  the  target  motion  between 
p;ngs,  smoothing  of  the  data  is  required  in  order  to  form  a sensible  target 
track.  Actual  rms  error  of  range  samples  in  the  2D  pings  before  the 
maneuver  was  67.4  meters,  while  the  actual  rms  error  in  ranqe  rate  samples 
was  1.45  meters/second.  Performance  of  various  forms  of  the  Kalman  filter 
will  be  compared  in  terms  of  the  amount  of  smoothing  of  these  data  points 
durinn  steady-state  conditions  and  by  the  general  nature  of  the  response  to 
the  maneuver. 
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Figure  3b  shows  the  data  as  tracked  by  the  Kalman  filter;  an  arbitra- 
rily selected  relaxation  time  of  30C  seconds  is  used.  Each  circled  dot 
represents  the  output  of  the  filter  imnedi ately  after  a ping  is  received, 
while  the  straight  line  is  the  prediction  from  that  noint  until  the  next 
ping,  as  would  be  performed  hy  the  second  block  in  fiqure  1.  Hurinq  the 
steady-state  portion  of  the  track,  rms  range  error  was  reduced  to  19.0b 
meters,  or  a factor  of  about  3.0.  Rms  range  rate  error  was  reduced  to  1.11 
meters/second,  or  only  slightly  below  that  of  the  input  data.  Response 
during  the  maneuver  was  good,  primarily  as  a result  of  the  limited  smoothing 
of  range  rate  data.  Since  the  relaxation  time  t determines  the  steady-state 
values  of  the  P matrix,  selection  of  this  parameter  determines  the  effective 
filter  time  constants  and  thus  the  balance  between  smoothing  and 
responsiveness.  Significantly  larger  t would  improve  the  smoothing,  but  at 
the  expense  of  responsiveness  to  the  maneuver.  Mote  that  the  rate  estimate 
stays  nearly  constant  between  pings,  and  there  is  no  tendency  for  it  to 
predict  the  actual  range  rate  changes  during  the  maneuver.  This  is  due  to 
the  two-state  model  used;  any  prediction  of  range  rate  wou^d  require 
addition  of  a third  acceleration  variable  to  the  state  vector. 


It  is  interesting  to  compare  this  track  with  one  obtained  using  only 
the  range  data  from  each  ping  and  ignoring  the  range  rate  data  obtained  from 
echo  doppler.  This  track  is  shown  in  figure  3c.  The  rms  range  error  during 
the  straight-line  portion  of  the  track  was  38.40  meters,  or  about  double  the 
error  obtained  when  the  rate  data  was  included.  The  rms  range  rate  error, 
derived  entirely  from  the  range  samples,  was  1.8?  meters/second,  which  is 
inferior  to  the  samples  of  the  input  rate  data.  This  form  of  the  Kalman 
filter,  estimating  range  and  rate  from  range  data  only,  is  equivalent  to  the 
" <,  .•  tracker"  often  used  in  radar  systems. 


As  mentioned  previously,  the  smoothing  performance  of  the  Kalman  filter 
tracker  shown  can  be  improved  by  increasing  the  assumed  value  of  t,  but  the 
rospi'f-o  to  manouvors  eventually  becomes  unacceptable.  This  conflict  can  he 
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Figure  3a. 

Raw  Measurement  Data  Points 


Figure  3b. 

Kalman  Filter  Tracker  Output 
(x=  300  sec) 
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overcome  by  attempting  to  sense  target  maneuvers  and  adapting  the  parameters 
of  the  filter  to  them.  This  is  rather  easy  to  do  with  a Kalman  filter, 
based  on  the  fact  that  the  scalar  ^unction 

z = [v-HX]t  [ HPH t +R J- 1 [Y-HX] 

is  a normalized  chi -squared  random  variable  with  degrees  of  freedom  equal  to 
the  size  of  the  measurement  vector,  when  the  target  and  measurement  data  are 
properly  modeled.  If  this  statistic  is  formed  for  each  data  sample,  it  may 
be  tested  against  a threshold  to  determine  whether  the  input  data  residuals 
are  reasonably  explainable  as  random  errors.  If  an  abnormally  large  value 
of  z occurs,  it  may  be  used  as  a signal  that  the  target  has  maneuvered  and 
that  we  wish  to  increase  the  responsiveness  of  the  filter.  Two  simple  ways 
of  implementing  this  will  be  illustrated:  the  first  using  samples  of  z to 
adapt  the  parameter  x to  the  target  behavior,  and  the  second  operating 
directly  on  the  P matrix. 

Adaptation  in  x is  performed  by  continually  increasing  x (decreasing 
the  assumed  maneuvers  of  the  target)  as  long  as  z does  not  exceed  a 
threshold,  and  decreasing  x whenever  a large  value  of  z suggests  that  the 
target  may  be  maneuvering  faster  than  the  model  assumed.  This  can  be  done 
in  rather  crude  ways,  since  changes  in  x only  affect  the  rate  of  growth  of 
the  P matrix  which,  in  turn,  determines  the  Kalman  gains.  Figures  3d  and  3e 
show  the  performance  of  two  trackers  using  adaption  in  x.  In  the  first 

case,  a threshold  z was  set  at  the  median  value  1.386  of  the  chi-squared 

o 

variate,  and  x was  doubled  whenever  z fell  below,  and  cut  in  half  when  z 
exceeded  z . With  this  approach,  one  would  expect  x to  stabilize  around  a 
value  consistent  with  the  random  maneuvers  of  the  target.  During  the 
straight-line  portion  of  the  example  run,  x did  increase  to  very  large 
values  consistent  with  tne  non-maneuvering  target.  This  was  reflected  in 
additional  smoothing  of  the  input  data,  particularly  in  range  rate.  The  rms 
range-rate  error  at  the  tracker  output  was  P.37  meters/second,  or  about  a 
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Figure  3d. 
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Figure  3e. 
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third  that  of  the  non-adaptive  tracker,  while  the  range  error  was  not 
significantly  different  from  the  non-adaptive  case.  Once  the  maneuver 
started,  it  was  detected  immediately  by  the  z statistic  test.  However,  the 
filter  output  did  lag  significantly  in  both  range  and  rate  while  the  x 
values  were  being  reduced  enough  to  affect  the  P matrix,  and  therefore,  the 
input  data  weightings. 

Figure  3e  shows  the  somewhat  different  performance  obtained  when  the 

threshold  z was  changed  to  the  80  percentile  point,  3.219,  on  the  chi-square 

0 4 I 

distribution.  In  this  case  t was  increased  by  only  W 2 or  about  20  percent 

when  z was  below  z , but  still  was  cut  in  half  when  z exceeded  the 
o 

threshold.  This  still  causes  x to  seek  the  proper  long-term  value  but  to 
increase  less  rapidly  during  non-maneuvering  periods.  This  led  to  a more 
responsive  track  when  the  maneuver  occured  in  the  example,  but  at  the 
expense  of  an  increase  in  the  rate  tracking  error  during  the  straight-line 
segment. 

The  second  method  of  adaptation  has  less  to  do  with  the  physical  model 
of  the  target  but  is  also  quite  effective.  This  technique  simply  increases 
the  value  of  the  P matrix  (which  essentially  means  that  less  is  known  about 
the  state  of  the  target  than  first  believed)  whenever  z exceeds  a threshold. 
Since  each  new  measurement  tends  to  decrease  the  P matrix  anyway,  it  is  not 
necessary  to  reduce  the  P matrix  when  z falls  below  the  threshold.  It  is 
possible  to  make  selective  increases  in  the  P matrix  whenever  a simple 
relation  exists  between  the  state  variables  and  the  measured  data,  for 
example,  increasing  both  the  row  and  column  corresponding  to  a given 
variable  whenever  its  residual  exceeds  a threshold.  However,  in  the  example 
shown  in  figure  3f,  the  entire  P matrix  is  simply  doubled  whenever  z exceeds 
the  95  percentile  point,  5.991.  Since  the  P adaptation  provides  a means  of 
increasing  the  P matrix,  the  random  excitation  in  the  tarqet  model  was 
removed.  This  made  the  model  correspond  to  a non-maneuvering  target  and 
left  the  adaptive  mechanism  as  the  only  means  of  avoiding  divergence  in  the 
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filter.  Note  th  it  !-.t  ''no  the  straight- line  portion  of  the  track  the  rms 
range  rate  e^-or  .ns  on!  / o.n.’q  rr^ters/second , reduced  about  a factor  of  30 
from  the  error  uf  the  input  data.  However,  because  the  P00  term  of  the  P 
matrix  gets  quite  small,  the  filter  is  slow  to  respond  to  changes  in 
the  range  rate  ever,  after  the  maneuver  is  detected.  This  could  be  avoided 
b.v  keeping  a small  randomness  in  the  target  model  to  limit  the  smoothing  of 
the  range  rate  data. 

While  neither  of  the  methods  of  adaption  discussed  here  completely 
reaches  the  goal  of  an  optimum  track  for  both  maneuvering  and  non- 
maneuvering targets,  both  are  quite  simple  to  implement  and  provide  some 
performance  improvement.  Iri  a practical  application,  one  or  the  other  (or 
perhaps  a combination  of  the  two)  could  provide  useful  improvements  over 
non-adaptive  trackers. 

A second  interesting  use  can  be  made  of  the  P matrix  information  in  the 
Kalman  filter.  As  we  have  seen  earlier,  the  P matrix  can  be  projected  into 
the  future  to  show  the  state  of  target  uncertainty  at  some  future  time, 
assuming  no  more  information  is  gained  from  the  sonar.  This  in  itself  is 
tactically  useful.  We  can  also  estimate  the  effect  of  an  additional  sonar 
pinq  by  projecting  the  P matrix  to  the  predicted  time  of  the  echo,  adjusting 
it  to  account  for  the  information  expected  from  that  echo,  and  then 
continuing  the  projection  on  into  the  future.  This  can  be  used  as  an 
algorithm  for  selecting  ping  waveforms  in  a multimode  sonar. 

Suppose  there  is  some  time  in  the  future,  such  as  the  expected  time  of 
arrival  of  a weapon,  at  which  the  tarqet  range  should  be  known  as  accurately 
as  possible.  By  carrying  out  the  above  process  for  each  of  the  available 
ping  waveforms,  the  expected  future  range  uncertainties  can  be  compared  and 
the  waveform  giving  the  lowest  value  for  P^  selected.  The  form  of  the 
previously  shown  equation  for  P^(t)  shows  the  intuitive  result  of  this 
process.  The  portion  of  this  expression  which  can  be  affected  by  the  ping 
waveform  selected  is  P^(t  ) + ?(r,T)P^(to  + (m )'  P??(to) . As  long  as  the 
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projection  is  far  into  the  future  so  that  ax  is  large,  it  is  important  to 
minimize  P^ft  ) and  waveforms  with  good  doppler  resolution  will  tend  to  be 
preferred.  Once  the  projection  time  becomes  short,  however,  the  P^t  ) term 
becomes  the  most  important  and  waveforms  with  good  range  resolution  will 
tend  to  be  selected.  It  is  also  clearly  an  advantage  to  make  P^tg)  as 
negative  as  possible,  which  leads  to  a preference  for  waveforms  with  large 
negative  P12(to^ 

Consider,  as  an  example,  a sonar  with  the  option  of  either  continuous 

wave  (CW)  or  upward  or  downward  linear  FM  transmissions.  As  before,  we  will 

assume  for  a ping  duration  of  T seconds  that  the  time  (range)  measurement 

2 

variance  of  the  CW  signal  is  T and  the  variance  of  the  frequency  (range 

2 

rate)  measurement  is  1/T  with  no  correlation  between  them  and  independent 

of  signal-to-noise  ratio.  Figure  4 shows  how  the  R matrix  is  derived  for 

the  linear  FM  signals,  by  means  of  the  familiar  ambiguity  function  for  such 

2 

signals.  The  mean  square  range  error  when  doppler  is  unknown  is  still  T , 

2 

but  this  value  reduces  to  1/W  when  the  target  doppler  is  known.  Similarly, 

2 

the  variance  in  frequency  when  range  is  unknown  is  W , while  it  becomes 

2 

1/T  when  the  range  is  known.  Since  the  diagonal  terms  of  the  R covariance 

matrix  are  the  variances  of  the  marginal  error  distributions,  and  since 

the  conditional  variances  are  smaller  than  the  marginal  variances  by  the 
2 

factor  1 - r-|2  /R11R22*  we  fl'nd  that  ^or  a ^inear  FM  S1’9nal  the  R matrix 
is  of  the  form 


"Rll 

R12 

J”  T2  +yw2T2-l~ 

R21 

R2? 

|^+  y W2T2-1  w2 

where  the  plus  sign  applies  for  upward  FM  signals  while  the  minus  sign 
applies  for  downward  FM  signals. 
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Figure  4.  Ambigutiy  Matrix  for  Linear  FM  Signal 


Limited  simulation  experiments  with  such  a sonar  confirm  that  when  the 
objective  time,  at  which  the  range  error  is  to  be  minimized,  is  well  into 
the  future  the  CW  mode  is  invariably  selected  because  of  its  better 
range  rate  accuracy.  As  the  objective  time  approaches,  the  sonar  finally 
switches  to  a down-slope  FM  signal  to  take  advantage  of  its  conditional 
range  accuracy.  The  down-slope  is  preferred  to  the  up-slope  FM  because  the 


range  rate  error  tends  to  be  in  a direction  to  reduce  the  range  error  at  a 

future  time.  If  all  parameters  of  the  problem  were  known  in  advance,  it 

appears  that  one  could  pre-compute  the  optimum  time  to  switch  from  CW  to  FM 

transmissions.  However,  if  this  technique  is  to  be  combined  with  adaption 
or  with  compensation  for  observed  signal-to-noise  ratios,  it  may  be  an 
advantage  to  do  the  waveform  selection  computations  in  real  time  on  each 
ping. 


SUMMARY 

This  document  has  presented  the  application  of  Kalman  filter  techniques 
to  range  and  doppler  tracking  in  active  sonar  systems.  The  Kalman  filter 
inherently  provides  an  uncertainty  matrix,  which  indicates  the  accuracy  of 
the  solution.  This  uncertainty  matrix  formation  can  also  be  used  to  provide 
adaptive  operation  and  to  aid  in  waveform  selection  in  multi-mode  sonars. 
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